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[57] ABSTRACT 

The invention fulfills new goals for redundancy resolu- 
tion based on manipulator dynamics and end-effector 
characteristics. These goals are accomplished by em- 
ploying the recently developed configuration control 
approach. Redundancy resolution is achieved by con- 
trolling the joint inertia matrix or the end-effector mass 
matrix that affect the inertial torques, or by reducing the 
joint torques due to gravity loading and payload. The 
manipulator mechanical-advantage and velocity-ratio 
are also used as performance measures to be improved 
by proper utilization of redundancy. Furthermore, end- 
effector compliance, sensitivity, and impulsive force at 
impact are introduced as redundancy resolution criteria. 
The new goals for redundancy resolution allow a more 
efficient utilization of the redundant joints based on the 
desired task requirements. 

15 Claims, 11 Drawing Sheets 
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KINEMATIC FUNCTIONS FOR REDUNDANCY 
RESOLUTION USING CONFIGURATION 
CONTROL 

5 

ORIGIN OF THE INVENTION 

The invention described herein was made in the per- 
formance of work under a NASA contract, and is sub- 
ject to the provisions of Public Law 96-517 (35 USC 1Q 
202) in which the contractor has elected not to retain 
title. 

BACKGROUND OF THE INVENTION 

1. Technical Field 15 

The invention relates to robotic control methods 

using configuration control techniques disclosed in U.S. 
Pat. No. 4,999,553. 

2. Background Art 

L Introduction 20 

Redundant robot manipulators possess more joint 
degrees-of- freedom than are required for the basic task 
of controlling the end-effector motion. The “extra” 
joints can provide high dexterity and versatility by 
enabling the robot to accomplish additional tasks. This 25 
is based on the observation that for a given end-effector 
location, the manipulator can assume infinite distinct 
configurations, each with a different measure of task 
performance, such as manipulability index. This pro- 
vides a basis for utilization of redundancy to improve 30 
the task performance measure by formulating this re- 
quirement as an additional task. However, since the 
robot performs a variety of diverse tasks, the motivation 
for utilizing the redundancy in each task can be widely 
different. For instance, in a free-space motion task, the 35 
redundancy can be used to reduce the inertial torques or 
increase the efficiency of end-effector motion; whereas 
in a constrained contact task, improvement of mechani- 
cal-advantage or reduction of impulsive impact force 
are appropriate goals. Therefore, the resolution of re- 
dundancy must be based on the particular task to be 
performed. 

In the description that follows, reference is made to 
individual publications listed numerically at the end of 45 
this specification by number (e.g., such as “[1]”). 

While redundancy is a desirable feature in a robot 
manipulator, the presence of redundant joints compli- 
cates the manipulator control problem considerably. 
The control of redundant robots has been the subject of 50 
considerable research during the past two decades. 
Despite this long history, previous investigations are 
often focused on the Jacobian pseudoinverse approach 
proposed originally by Whitney [1] in 1969 and im- 
proved subsequently by Liegois [2] in 1977. This ap- 55 
proach resolves the redundancy at the velocity level by 
optimizing an objective function, and produces non- 
cyclic motions. For instance, using the Jacobian pseu- 
doinverse approach, Suh and Hollerbach [3] suggest 
methods for minimization of instantaneous joint 60 
torques. Khatib [4] proposes a scheme to reduce joint 
torques by using the inertia-weighted Jacobian pseu- 
doinverse. Dubey and Luh [5] and Chiu [6] use the 
pseudoinverse approach to optimize the manipulator 
mechanical-advantage and velocity-ratio using the 65 
force and velocity manipulability ellipsoids. Walker [7] 
resolves the redundancy by reducing the impulsive 
force at impact using the Jacobian pseudoinverse ap- 


2 

proach. Maciejewski and Klein [8] describe a method 
for obstacle avoidance based on pseudoinverse control. 

In recent specifications [9-16], a new approach called 
configuration control is proposed for resolution of re- 
dundancy and control of redundant manipulators. This 
approach is based on task augmentation and resolves the 
redundancy at the position (i.e., task) level, thereby 
yielding cyclic motions. In this approach, the basic task 
of end-effector motion is augmented by a user-defined 
additional task for redundancy resolution. In previous 
specifications, the additional task is chosen as posture or 
self-motion control [15,16], optimal joint movement 
[14,16], or collision avoidance [13,16]. This specification 
introduces further options for additional task based on 
manipulator dynamics and end-effector characteristics. 

The structure of the specification is as follows. Sec- 
tion 2 describes new additional task options for redun- 
dancy resolution within the configuration control 
framework. A simple planar three-link manipulator is 
used in the computer simulation studies of Section 3 to 
illustrate some of the concepts introduced in the specifi- 
cation. Section 4 discusses the results of the specifica- 
tion and draws some conclusions. 

SUMMARY OF THE INVENTION 

2. Task Options for Redundancy Resolution 

In this section, we present a number of task options 
that can be accomplished through redundancy resolu- 
tion, in addition to the basic task of end-effector motion. 
This provides a suite of additional tasks from which the 
appropriate task can be selected by the user based on the 
particular application at hand. The user can also attempt 
to achieve multiple additional tasks simultaneously 
using the method described in [14]. 

Consider a kinematically redundant robot manipula- 
tor having n joints with its end-effector operating in an 
m-dimensional task- space, where m<n. The forward 
kinematic model which relates the mXl end-effector 
coordinate vector Y to the n X 1 joint angular position 
vector 0 is given by 

y=m (i) 

and the differential kinematic model is represented by 

Y=W)6 (2) 

where the m X 1 vector f denotes the nonlinear forward 
kinematic functions, and 



is the mXn end-effector Jacobian matrix. For free- 
space (i.e., unconstrained) motion, the dynamic model 
of the manipulator relating the nx 1 joint torque vector 
to the joint angles 8 can be described by 

T ^M(6)e+N{eM+G(8) (3) 

where M(0) is the n Xn joint inertia matrix, N(0,0) is the 
nxl vector of Coriolis, centrifugal and frictional 
torques, and G(0) is the nxl vector of gravitational 
torque. It is seen that the total joint torque *T is com- 
posed of three components. The first and second com- 
ponents in (3) are the acceleration-dependent and 
velocity- dependent torques M(0)0 and N (0 ? 0). How- 
ever, the coefficients through which 0 and 0 generate 
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joint torques are functions of the joint angles 0. On the 
other hand, the third component in (3), namely the 
gravity torque G(0), depends only on the manipulator 
configuration 6. 

In the configuration control approach [9-1 1], the user 5 
defines a set of r (=n— m) kinematic functions d>=h(0) 
to be controlled during the basic task of specified end- 
effector motion Y=Y^(t). The kinematic model (1) is 
then augmented to include <5> as 

10 

-CHS) 

where X is the n X 1 configuration vector. The user can 15 
then set up an additional task for redundancy resolution 
by imposing the constraint <h(0)=<t>d(t), where d>^t) is 
the user-specified desired time variation of <t>. Once <1> 
and &d are defined, the manipulator control problem is 20 
to ensure that the configuration vector X tracks the 
desired trajectory 



using either a kinematic or a dynamic control law [9,14]. 
This formulation puts the redundancy resolution con- 30 
straint on the same footing as the end-effector task, and 
treats both Y and d> equally in a common format. 

Because of the user’s freedom in the selection of the 
kinematic functions d>, the configuration control ap- 
proach provides a general methodology for task-based 35 
resolution of redundancy. In this section, we present 
various alternatives for redundancy resolution through 
the definition of the kinematic functions <t> within the 
configuration control framework. 

40 

BRIEF DESCRIPTION OF THE DRAWINGS 

FIG. 1 is a block diagram of a robot control system 
embodying the present invention. 

FIG. 2 illustrates a three link robot coordinate system 
employed in analyzing the invention. 45 

FIGS. 3a-3d illustrate, respectively, robot configura- 
tions, tip x-position response, tip y-contact force and 
variation of kinematic function in one application of the 
invention. 

FIGS. 4a-4d illustrate, respectively, robot configura- 
tions, tip x-position response, tip y-contact force and 
variation of kinematic function in another application of 
the invention. 

FIGS. Ba-Sd illustrate, respectively, robot configura- 55 
tions, tip x-position response, tip y-contact force and 
variation of kinematic function in yet another applica- 
tion of the invention. 

FIGS. 6 a-6d illustrate, respectively, robot configura- 
tions, tip x-position response, tip y-contact force and 50 
variation of kinematic function in a further application 
of the invention. 

FIGS, la and lb illustrate, respectively, variation of a 
sensitivity function and variation of a kinematic func- 
tion in a still further application of the invention. 65 

FIGS. 8 a and 86 illustrate, respectively, variation of a 
sensitivity function and variation of a kinematic func- 
tion in still another application of the invention. 


DETAILED DESCRIPTION OF THE 
INVENTION 

Referring to FIG. 1, the configuration control 
method described in U.S. Pat. No. 4,999,553 (the disclo- 
sure of which is hereby incorporated herein by refer- 
ence in its entirety) finds the required joint motions such 
that the configuration vector X(0) tracks the desired 
trajectory Xj(t). This formulation puts the redundancy 
resolution constraint on the same footing as the end 
effector task motion and treats both Y and <f> equally in 
a common format. As illustrated in FIG. 1, a basic (de- 
sired) task trajectory Y^is defined as a function of time 
to a basic task controller while an additional task trajec- 
tory is defined as a function of time to an additional task 
controller. The basic task controller and the additional 
task controller produce torque commands T e and T c 
respectively which are summed at a summing node and 
input to manipulator dynamics. The manipulator dy- 
namics produces a new vector © of joint angles from 
which augmented forward dynamics compute the latest 
values of Y and 4> which are fed back to the controllers 
and compared with the current desired values of Y^ and 
in a feed-back control architecture. As indicated in 
FIG. 1, the additional task trajectory is specified by r 
kinematic functions defming a minimization of an objec- 
tive function over r joints which the user may select 
from among the n joints of the robot. It is a discovery of 
the invention that the objective function may specify 
gravity loading, joint inertia, mechanical advantage, 
velocity ratio, end effector sensitivity, end effector 
compliance or end effector impact force, so that these 
quantities may be controlled or optimized (minimized) 
using the self-motion available to a redundant robot 
performing a required task motion of its end effector. 

2.1 Gravitational Torques 

In this case, the redundancy is utilized to minimize 
the effect of gravity loading on the joints or to reduce 
the gravity torque due to a payload during a specified 
end-effector motion. This yields the optimal configura- 
tion for which the payload capacity of the manipulator 
is maximized. It also enables the user to optimally pre- 
configure the redundant manipulator before picking up 
the payload. 

The joint torque due to gravity loading is represented 
by G(0) in (3), and is configuration-dependent. Let us 
define the scalar weighted gravity loading objective 
function as 


L g = G T (6)WG(e) -2 WjG'HO) (j) 

i—\ 

where the nXn constant matrix W=diagr[w/} repre- 
sents the weighting factors assigned by the user to the 
joints. In order to optimize L g subject to the end-effec- 
tor constraint Y=f(0), from Appendix 5.1 we require 


where N*is the rxn matrix whose rows span the null- 
space of the end-effector Jacobian J e , that is, NJe^O. 
The optimality condition (6) can be treated as a set of 
kinematic constraints by defining the r kinematic func- 
tions 



5 


5,294,873 


<t> = m = w)-^- 

and their desired trajectory as O^(t)$0. Therefore, the 5 
optimal joint torque requirement can be stated as 
<j)(0)=<j>^(t), and the configuration control approach 
can be adopted to ensure that the optimality condition 
(6) is satisfied while the end-effector is tracking the 
desired trajectory Y</(t). Note that the manipulator must 10 
be initially at an optimal configuration which satisfies 
condition (6). This scheme for redundancy resolution is 
illustrated by a numerical example in Section 3. 

The redundancy can alternatively be used to reduce 
the gravity torque due to a payload. The torques ex- 15 
erted at the manipulator joints due to a payload carried 
by the end-effector are functions of the manipulator 
configuration. In general, the payload contributes both 
dynamic and static terms to the manipulator dynamic 
model. In this case, we are concerned solely with the 20 
static torque due to gravity. In particular, for a given 
payload and end-effector position and orientation, the 
redundancy is resolved to yield the optimal joint config- 
uration where the payload gravity torque is at a mini- 
mum. 25 

Suppose that the end-effector is holding a payload 
represented by a point mass p. Then, the static joint 
torque due to the payload is 


6 

a result, a choice of 0 that reduces M(0) may yield a 
large joint acceleration profile 0(t) and consequently 
demand a large inertial torque T Nonetheless, it is 
possible to use the redundancy to affect the norm or 
some entries of the inertia matrix. For instance, the 
redundancy can be used to influence certain elements of 
the joint inertia matrix. Consider a typical joint of the 
manipulator 0/ where the joint dynamics can be written 
as 

T f = mm + + m, «> + om ' !0 ' 

m 

It is seen that the inertia M ,v<0) seen at joint i is a func- 
tion of all joint angles 0, i.e., the robot configuration. 
Furthermore, there are inertial couplings between the 
joints, represented by DM (/(0)0/, with the coupling fac- 
tor M ij dependent on the robot configuration. To sim- 
plify the joint control system design, it is sometimes 
desirable to ensure that the inertia M/ z <0) is invariant 
with respect to the manipulator configuration 0, that is, 
M/*<0) is a predefined constant. Let the manipulator be 
at the initial joint configuration 0° with the correspond- 
ing joint i inertia M zz <0°). In order to ensure that 

Miffi) = = constant (11) 


T p ~pJ e r g ( 7 ) 30 

where g is the m X 1 vector of gravitational accelera- 
tions. The weighted sum-of-squares of joint torques due 
to the payload is 

35 

Lp * it i Wfl P i = ^ i=\ w & J * T & l2 (8) 

where {w ,*} are the joint weighting factors specified by 
the user. The optimization of L p subject to the end- 40 
effector motion constraint leads to the condition 


Ntf)‘ 


~ 


( 9 ) 


45 


By satisfying (9), we ensure that the manipulator config- 
uration is kept at the minimum payload gravity torque 
during the end-effector motion. 

2.2 Joint Inertia and End-Effector Mass 

In this case, the redundancy is utilized to obtain some 50 
desirable characteristics for the manipulator inertia 
matrix in joint space or the mass matrix in Cartesian 
space. This is motivated by the fact that the inertia and 
mass matrices depend solely on the manipulator config- 
uration 0, and thus by suitable definition of the kine- 55 
matic functions, we can influence the inertial torque 
directly. It is important to note that often the inertial 
torque is the dominant term in the manipulator dyanmic 
model, particularly during slow motions where the 
contributions from the velocity-dependent torques are 60 
insignificant. As a result, this approach can lead to reso- 
lution of redundancy based on torque reduction. 

Despite the fact that the joint inertia matrix M(0) in 
the dynamic model (3) is configuration-dependent, the 
reduction of the “size” of M(0) does not necessarily 65 
reduce the inertial torque *T fl =M(0)0. This is because 
the trajectory for the joint acceleration 0(t) depends on 
the evolution of the manipulator configuration 0(t). As 


throughout the end-effector motion, we define the kine- 
matic function as <j) / (0)=M/ i <0) and its desired trajec- 
tory as 4>d/<t)=M/X0°). Note that since r kinematic func- 
tions can be controlled independently, in general this 
formulation can be used to make r joint inertias configu- 
ration-independent. The configuration control scheme 
can then be employed to ensure that the joint inertias 
are held constant and configuration-invariant, while the 
end-effector is traversing the prescribed path. This ap- 
proach is illustrated in Section 3. 

An alternative approach is to utilize the redundancy 
to decrease the off-diagonal elements of the joint inertia 
matrix M(0). This is a desirable feature for control pur- 
poses since it can reduce the inter-joint couplings and 
thereby enhance the stability and improve the system 
performance. In the ideal case, we wish to make the 
joint inertia matrix diagonal so as to ensure inertial 
decoupling. To this end, the objective function can be 
defined as 





Following the method of Section 2,1, we can utilize the 
manipulator redundancy to minimize L mz by satisfying 
the optimality criterion 




*L mi 

se 


= o 


03 ) 


Using the configuration control approach, the off-dia- 
gonal elements in the inertia matrix M(0) are reduced 
optimally, while the end-effector is following the pre- 
scribed path. However, note that since the inertial cou- 
pling torque DjM is also dependent on the joint 
accelerations 0(t), this approach does not necessarily 
lead to a reduction in inter-joint couplings. 
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The redundancy can also be utilized to affect the 
end-effector mass matrix. The manipulator dynamic 
model (3) used so far is in joint-space, as it relates the 
joint torques ‘T to the joint angles 6 . An alternative 
approach is to use the manipulator dynamic model in 5 
the Cartesian-space for redundancy resolution. The 
Cartesian-space dynamic model relating the m X 1 ap- 
plied end-effector force/moment vector T y to the mX 1 
end-effector coordinate vector Y can be obtained as [4] 

10 

T y =M/6)V+N/e t e)+c^e) (i4> 

and file above terms are related s ^o S Sitfr jomt-space 
counterparts by 

15 

M/e)=[ue)M- he)Je T m - 1 


8 

. . <X]. Then, using the norm inequality [17], from 
we can write 

l|MJ S ^||J/lls-||M,||s 08) 

or 

ilMeHs^o-l^m - 1 09) 

where cr\ = || J e T \\ s=[Max Eigenvalue^* 7 )]* (from 
Appendix 5.2) and A m _1 = || My || 5 — Max Eigen- 
viue(My). Equation (19) establishes an upper-bound on 
|| Me || 5 the .. Je 

Je r . Hence, using || ‘T m || ^ || Me || 5 * || Y || , we obtain 

||.T«||^<ri.x OT -h|jV|| (20) 


N,t6,e)=M£6)[JAe)M- He)N(e,b)-M0,e)e] ( 15 ) 

G/e^M/eyww- Hwae) 

where My(0) is the mXm end-effector Cartesian mass 
matrix, and J e(0) is assumed to be of full rank. The end- 
effector Cartesian force Fy is then mapped into the 
equivalent joint torque 7 e through the Jacobian matrix 
] e , that is, 7 e =3e 7 XQ) r F y • Thus, the dynamic model 
that relates the joint torque 7 e required for end-effector 
motion to the end-effector Cartesian coordinates Y is 
given by 


Now, <r\ and A m are both functions of the manipulator 
configuration, i.e., the current values of the joint angles 
6. Therefore, we can utilize the redundancy to reduce 
20 the inertial torque for a given end-effector acceleration 
by reducing the configuration-dependent quantity 
L m (6)=*cri-\ m - 1 . To this end, L m (0) is defined as the 
objective function to be minimized through redundancy 
resolution, and the condition for optimality of L m sub- 
ject to the end-effector motion is stated as 


( 16 ) 

It is noted that in the configuration control approach, 
the total joint torque 7 is the sum of the two compo- 
nents 7*=J* r 7y due to the end-effector motion (basic 
task) and 7 c =Jc 7 7 c due to the kinematic constraints 
(additional task), where J c and 7 c are the Jacobian 
matrix and control forces related to <J> [9]. 

From the robot dynamic model (16), the inertial 
torque required to cause end-effector motion is given by 
•T /n~Me(6)Y, where Me(0)==J*7(0)My(0) is an nXm 
configuration-dependent coefficient matrix. Thus, the 
coefficient matrix M*(0) can be viewed as the operator 
that maps the end-effector acceleration Y into the iner- 
tial torque *7 that is M*( 0 ): V— >7 m . By considering 
the mapping properties of this operator, we can influ- 
ence directly the inertial torque required for a given 
end-effector acceleration. One suitable measure of this 
mapping operator is the spectral norm [17] of the coeffi- 
cient matrix M*(0) defined as 


I! || s = .max 
Y-- 5*0 


\\MeY\\ 

T^T 


(17) 


where the scalar || Y || ^[Y 7 ^]* denotes the Euclidean 
norm of the end-effector acceleration vector V. The 
spectral norm of M e defined in (17) is a measure of the 
largest amount by which any acceleration vector is 
amplified by the matrix multiplication, i.e., || M*Y || ^ 
II Me || S’ || Y || for all Y. In other words, || M e || 5 
bounds the “amplification factor” of the coefficient 
matrix M e . Let My-^J^M-Jj^ denote the inverse of 
the end-effector mass matrix, where the dependency on 
6 is omitted for simplicity. Note that My - 1 and My are 
mXm symmetric positive-definite matrices with posi- 
tive eigenvalues {A m , . . . , Ai) and {A]- 1 , . . . , A m -!}, 
respectively, arranged in increasing order, with 0<A m . 


As in Section 2.1, the configuration control scheme can 
now be used to ensure that the end-effector follows the 
desired trajectory while the redundancy is utilized to 
optimally reduce an upper- bound on the inertial torque 
3 5 norm. 

When efficient real-time computational tools for 
spectral analysis are available, the spectrums of JJ* r 
and My can be computed and L m (^)=o-i«A m ” 1 can be 
controlled directly. Otherwise, we can compute the 
40 “traces” of J^J^and My, and noting that cn<[trace(- 
JeJe 7 )]* and A m “ 1 <trace(My), we can replace <r\ and 
A m _1 in the objective function b m (6) by their upper- 
bounds [traceCM* 7 )}* and trace(My) to reduce the com- 
putations and then proceed with the constrained optimi- 
45 zation of L m ( 0 ). 

It must be noted that in using the end-effector dy- 
namic model (16), the end-effector acceleration Y is 
specified by the basic task, and therefore the inertial 
torque needed for end-effector motion can be reduced 
50 through redundancy utilization as an additional task. 
This is in contrast to using the joint dynamic model (3) 
where 6 evoluation is unspecified and therefore inertial 
torque reduction is not necessarily achieved through 
reduction of || M ||s. Finally, it is important to note 
55 that the evaluation of the Cartesian terms in (16) is 
computationally very intensive, and therefore this ap- 
proach may not be suitable for real-time implementa- 
tion. 

2.3 Mechanical-Advantage 

60 For a redundant manipulator, the joint torques pro- 
duced when the manipulator makes contact with the 
environment depend on the manipulator configuration. 
In some applications, the manipulator configuration 
requiring lower joint torques for a given contact force is 
65 preferred over other configurations. This results in a 
higher mechanical- advantage and the ability to per- 
form tasks which demand greater end-effector contact 
forces. In applications requiring fine force control, a 
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low mechanical-advantage is preferable so as to in- 
crease the sensitivity of joint torques to end-effector 
forces. 

Suppose that the robot manipulator is interacting 
with the environment by exerting the mxl contact 
force/moment vector F at the end-effector, where some 
of the elements of F may be zero. The additional joint 
torque needed to exert the contact force F on the envi- 
ronment is given by 

T F=Je r (S)F (22) 

The mechanical-advantage of the manipulator is 
defined as the ratio of the norm of end-effector force to 
the norm of joint torque [5], that is 

^a=||FJ|/|| f\\ (23) 

A redundant manipulator allows us to obtain different 
mechanical advantages for the same end-effector 
contact force through self-motion. Using (22) and (23), 
we obtain 


M " f|i 

f t f 

1 ! 
f t f 


_ F T JeJ e T F _ 

_ F T H m F _ 


where H m =JeJ e r is an mXm symmetric positive semi- 
definite matrix having m real non-negative eigenvalues 
71 , y m with 71^72- ■ • ■ = 7m^0. It is seen that 

the mechanical advantage M a is a function of two vari- 
ables: the direction of the applied force F and the ma- 
nipulator configuration 0. We now establish bounds on 
M a regardless of F. From matrix theory [17], we have 
the inequality 


7 M [|F||2^H m FS yi j|F||2 (25) 

In (25), the equality signs hold when F = Fi or F=F m , 
where F\ and F m are eigenvectors of H m corresponding 
to the eigenvalues 71 and y m , that is 


|| FiU 2; 

F m r H m F m = y m ||F m |j 2 

Now, using (24) and (25) and assuming 7 m =?M3, the me- 
chanical advantage of the manipulator is bounded by 

Let us denote the m singular values of the end-effector 
Jacobian matrix J<?by cn^<r2 = ... O" m =0. In Appen- 
dix 5.2, it is shown that the eigenvalues of H m are 
squares of the singular values of J ft that is, 7/= cr, 2 . 
Thus, the bounds on M fl can be expressed in terms of the 
singular values of J e as 

(26) 

where <ri — [A^o^JeJe 7 )]* is also equal to the spectral 
norm of J<?, cri — || J e || s, and <r m is assumed to be non- 
zero. In other words, the mechanical advantage lies in a 
range defined by the largest and smallest singular values 
of J*(0). When the manipulator is at an end-effector 
kinematic singularity, 

J e(0) becomes rank-deficient and cr m =0. In this case, 
the mechanical advantage grows to infinity, which im- 
plies that a finite contact force can be produced by a 
very small joint torque. Although this is appealing from 


10 

a force application point of view, the end-effector loses 
mobility in certain Cartesian directions which is clearly 
undesirable [6], 

Now, since from (26) the bounds on M fl are functions 
5 of the manipulator configuration 0> they can be defined 
as kinematic functions within the configuration control 
framework and controlled directly during the end- 
effector motion. Computationally, it is more efficient to 
evaluate the Frobenius norm [17] of the Jacobian ma- 
10 trix, where || ■ || Fis the square-root of the sum of the 
matrix elements squared, i.e., || J<? || ^=2/= i n 2/= \ m 3 e 2 ~ 
(i,j)=trace[H m ]. Noting that tr[l|[ e ^ s Z, = 
obtain the inequality 

15 [Pell/T^Ma (27) 

Inequalities (26) and (27) imply that the joint torque 
norm cannot exceed the Jacobian norm times the ap- 
plied force norm, that is, 

20 

II'TfII = II Jp II s* II F || = || || p || F j| 

Note that the above inequality can also be obtained 
directly from (22). For applications requiring a high 
25 mechanical advantage, we can defme the objective 
function as L(0)= || J^tf) || /^and minimize L(0) during 
the end-effector motion. This optimization must be 
confined to a reasonable bound to ensure that the ma- 
nipulator is not at a kinematically singular configuration 
30 [6J. 

When the direction of the applied force is known, an 
alternative approach to controlling the bounds on the 
mechanical advantage M a is to utilize the redundancy to 
directly control the actual value of M a for a contact 
35 task. For a given joint configuration 0 , the mechanical 
advantage of the manipulator is dependent on the direc- 
tion of the applied contact force F, and varies in the 
range given by (26). Therefore, we can utilize the re- 
dundancy to minimize the joint torques required to 
40 produce a given contact force F on the environment 
and thus maximize the mechanical advantage. In other 
words, by internal movement of the links without mov- 
ing the end-effector, the robot is reconfigured to opti- 
mally reduce the required joint torques. The objective 
45 function L/to be optimized in this case can be defined as 

Lf= [ J e r ($)F] T [Je T (B)F] =F T H m {6)F (28) 

where F is a known unit vector in the direction of the 
50 force F to be applied by the end-effector, i.e. 
F=F/ || F || . For a given end-effector position/force 
trajectory, the problem is to find the optimal manipula- 
tor configuration such that the end-effector force F 
exerted on the environment is achieved with the mini- 
55 mum joint torque norm L/. The condition for optimality 
of L/subject to the end-effector motion can be stated as 


60 


Ntf) 


iLf 


= 0 


(29) 


As in Section 2.1, we can now ensure that the mechani- 
cal advantage is maximized during the end-effector 
motion. This is illustrated by a simulation example in 
65 Section 3. 

2.4 Velocity Ratio 

for a redundant manipulator, the joint velocities re- 
quired to move the end-effector with a specified Carte- 
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sian velocity depend on the manipulator configuration. 
Often, the manipulator configuration requiring lower 
joint velocities to achieve the same end-effector veloc- 
ity is preferable over the others. 

From (2), the mxl end-effector Cartesian velocity 
vector Y is related to the n X 1 joint velocity vector 6 
through the m X n end-effector Jacobian matrix J e(0) as 

Y=US)0 (30) 

The velocity ratio V r of the manipulator is defined as 
the ratio of the norm of end-effector velocity to the 
norm of joint velocity [5], that is 


Depending on the configuration of the redundant ma- 
nipulator, different velocity ratios can be obtained for 
the same end-effector Cartesian velocity. From (30) and 
(31), we obtain 


r eTjTjj 1* 

" T 

L m J " 

L e T e J 


The nXn matrix H v =J e 7 ^e is symmetric and positive 1 
semi-definite, with n real eigenvalues that are closely 
related to those of the mXm matrix H m =J e Je 7 ’, namely 
[y\, . . . , y m ]. In Appendix 5.2, it is shown that the n 
eigenvalues of H v consist of the m eigenvalues of H m 
and (n— m) zeros, that is [yi, . . . , y m , 0, . . . , 0] with 30 
yi ^ . . . ^y m =0. Thus, we can state the inequality 

0^H^ yi ||e||2 (33) 

The equality signs hold when 0 is an eigenvector of H v 35 
corresponding to yi or the zero eigenvalue. Thus, V r is 
bounded by 


o^v r ^ yi i 

40 

This inequality can be written in terms of the largest 
singular value of the end -effector Jacobian matrix J e as 

0^V r =cn (34) 

45 

where <ri=||J e ||s- Noting that 

tr[H v ]=tr[H m ]= || S e || F 2 and yi^tr[H v ], we obtain 

0= V r = || Je II F (35) 

Therefore, the velocity ratio is bounded by the largest 50 
singular value and by the Frobenius norm of the end- 
effector Jacobian matrix Je(0). Inequalities (34) and (35) 
imply that the end-effector velocity norm cannot ex- 
ceed the Jacobian norm times the joint velocity norm, 
that is, || Y |t ^ || J e || s- 1| « || ^ || Je || /- || © 11 - Note 55 
that this inequality can also be obtained directly from 
(30). When 0 is chosen to be an eigenvector of H v corre- 
sponding to the zero eigenvalue, that is Hy0 =0, then we 
have || Y || 2= || J^ || In this case, 

the joint motions do not produce any movement of the 60 
end-effector and the velocity ratio becomes zero. This is 
commonly referred to as “self-motion” in a redundant 
robot [12], 

Based on inequalities (34) and (35), the upper-bounds 
on the velocity ratio, namely <r\ or ||J c ||f, can be 65 
defined as the kinematic function 0 and minimized 
during the end-effector motion in order to decrease V r . 
This is an appropriate goal in applications requiring fine 


position control, such as guarded motion, where a large 
sensitivity of joint velocities to end-effector velocity is 
required. Alternatively, when the direction of 0 is 
known, we can optimize the norm of the normalized 
end-effector velocity, that is 

l v = [ueMuem = e T H^e)l (36) 

where $=6/ || 6 || is a known unit vector in the direc- 
tion of 0. Following a procedure similar to Section 2.3, 
we can maximize the velocity ratio V r through the 
objective function L v so that the joint motions are 
mapped into the end-effector motion most efficiently. 
This results in configurations requiring lower joint ve- 
locities to achieve the same end-effector velocity, and 
thus more efficient motion is obtained along the speci- 
fied task trajectory. 

It is important to not that the configurations for 
which the velocity ratio is high yield low mechanical 
advantage and vice versa. For instance, a singular con- 
figuration in which J e is rank-deficient yields a high 
mechanical advantage but a low velocity ratio. Since 
mechanical advantage and velocity ratio are conflicting 
measures of performance, in resolving the manipulator 
redundancy based on either or V r , we must take into 
consideration that the remaining quantity lies within an 
acceptable range [6]. 

2.5 End-Effector Sensitivity 

Manipulators usually have positioning errors at the 
joint angles due to backlash or flexibility of joint gear 
trains, imperfection of joint servo loops and so on. The 
joint errors or displacements A0 are propagated 
through the manipulator geometry to produce pertur- 
bation in the end-effector coordinates AY. Certain com- 
ponents of the end-effector perturbation can play a 
critical role in the execution of a task. For instance, 
when the end-effector is exerting a force on a work- 
piece having stiffness k, then a slight perturbation in the 
' end-effector coordinate y at contact will be magnified 
considerably by the stiffness k to produce the additional 
contact force kAy. This additional force can be exces- 
sive and may cause severe damage to the workpiece 
under contact. In this section, we discuss the utilization 
of redundancy to minimize a weighted sum of the end- 
effector perturbations due to small variations in the 
joint angles. 

From (30), the joint displacement A0 is mapped 
i through the Jacobian matrix J e(0) to produce the result- 
ing end-effector perturbation AY, that is, AY = J*(0)A0. 
Therefore, the sensitivity of the ith end-effector coordi- 
nate y / to the jth joint angle 0j is given by 


s / = TeT = [J * e) h' 


where the subscript i,j refers to the (i ,j)th element of the 
matrix. It is seen that Sf is solely a function of the ma- 
nipulator configuration 0, and can therefore be con- 
trolled during the end-effector motion. Alternatively, 
we can define a scalar function Lj(0) to represent a 
weighted sum-of-squares of end-effector perturbations, 
that is 


1 WjAy, 2 • 
i=l 


: (A Y) r ‘ W . A Y 
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where W=diag/{w/} is an mXm user-specified 
weighting matrix. Then, we obtain 


ue) - [ue)M] T w[ue)M] 

From matrix theory [17], the bounds on Ls(0) are given 


W J-) || A8 || 2£L J (0)^X max (j/W 
j«) II A* II 2 (39) 

where X m / n and refer to the smallest and largest 
eigenvalues of the matrix. Since J e is a symmetric 15 
positive semi-definite matrix, we have 
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figuration of the redundant robot, different compliance 
matrices can be obtained for the same end-effector posi- 
tion and orientation. Therefore, by a judicious choice of 
the manipulator configuration, we can choose the opti- 
mal configuration which yields the smallest end-effec- 
tor compliance [18], 

Now, for a given joint stiffness K, the end-effector 
compliance C(0) is only a function of the manipulator 
joint angles 0 . The Frobenius norm || C || Fean be used 
as a measure of the “size** of the compliance matrix C. 
Therefore, minimizing the Frobenius norm will tend to 
minimize the matrix elements, leading to a decrease in 
the end-effector compliance. As a result, the Frobenius 
norm of C (0) can be defined as the objective function 
L c , namely 


trace (JM) = £ UfJWJ € ) ^ 'K ma AJe T WJ e ) (40) 

1= 1 

Hence, an upper-bound on L*(0) is 

L^)^trace(j/WJ e )|[Ad||2 (41) 

By defining the objective function as the upper-bound 
on L j(0), namely Xmaxih 1 ^ J e ) or trace (L^V J e ), and 
minimizing Ls(0) during the end-effector motion, we 
can minimize the end-effector perturbation due to joint 
displacement. 

When the magnitudes of the joint angle variations A 0 
are known, an alternative approach to controlling the 
upper-bound on Lj(0) is to directly minimize the actual 
value of Ls(0) in (38) for a given joint angle variation. 
The condition for optimality of L*(0) subject to the 
end-effector motion can be stated as 


dZ.5 


= 0 


(42) 


This method is illustrated by a numerical example in 
Section 3. 

2.6 End-Effector Compliance 

The compliance of the manipulator end-effector is an 
important characteristic in determining the Cartesian 
positioning accuracy in the presence of disturbance 
forces and payloads. In this section, we discuss the 
resolution of manipulator redundancy based on the 
end-effector compliance. 

Suppose that a disturbance torque T applied at the 
manipulator joints causes the displacement A0, where 
A0 is dependent on the gains of the joint servo loops. 
The behavior of each manipulator joint can be modeled 
by a spring with stiffness coefficient k so that 

<T =KA8 (43) 

where K=diag,-{k,} is the nXn constant joint stiffness 
matrix. Let us now apply the end-effector force F and 
define the resulting end-effector displacement by AY. 
Then, F and AY are related by 


Ae=K- h 'T=K- ] J e r (8)F 


(44) 


therefore 


- mm* (46) 

Ltf) rn 1 1 0(9) | |j=2 = 2^.2^ c?/e) 

20 ' 1 

The manipulator redundancy can then be utilized to 
minimize L c as an additional task, similar to Section 2.1. 
As the norm of C(0) becomes smaller, the stiffness of 
the manipulator at the end-effector increases: This de- 
creases the overall end-effector deflection when sub- 
jected to Cartesian forces. An alternative approach is to 
control some entries of C(0) during the end-effector 
motion. This will reduce the deflection of the end-effec- 
3Q tor in certain Cartesian directions under externally ap- 
plied forces. This approach is illustrated in the Example 
of Section 3. 

2.7 Impact Force 

Robot manipulators often come into physical contact 
35 with workpieces during task execution. At the instant of 
contact, the manipulator undergoes an impact with the 
workpiece for a very short period of time. This impact 
creates an impulsive force at the end-effector which is 
propagated through the manipulator structure. If the 
40 magnitude of this impulsive force is large, it can have 
detrimental effects on the manipulator and the work- 
piece. The impact force is a function of the manipulator 
configuration at the instant of impact. As a result, for a 
redundant manipulator, the redundancy can be utilized 
45 to reduce the impact force, and thus aid in the robot- 
workpiece interaction [7]. 

For derivation of the impact force, it is more conve- 
nient to express the manipulator dynamics in Cartesian- 
50 space as in (14), that is 

enc/ 6 ) (47) 

where T a , T c and Y are the Cartesian actuator force, 
55 impact force and end-effector acceleration, M^=[- 
JeM-JJ* 7 ]- 1 is the end-effector mass matrix, and N y 
and G^are defined in (15). Suppose that the manipula- 
tor-workpiece initial impact occurs at time t for an 
infinitesimally short time period At. Then integrating 
60 both sides of (47) from t to t+At gives 

r t + At r t + At (48) 

^Tadt + ‘Tcdt = 

J t J t 


A *J e T (8)\F— C(6)F (45) 65 

where C(6)=Je(0)K- ] Je T (fi) is the mXm symmetric 
end-effector compliance matrix. Depending on the con- 


/ t + At , . r l *t- U' . r T ■+ ai 

M/6)Ydt 4- J N/6,e)dt + J G/6)dt 


• t + At 


t + At 



5,294,873 


16 


15 

Since 7 fl , 0 and 0 are finite at all times, the integrals 
of the finite functions 7 fl , N ^ and from t to t+At 0 £, c 

becomes zero as At— >0. Thus, (48) reduces to = 0 


( 56 ) 


-► r / + Ar . . 

7 c = 3//0) Kft = M/6)bY 

J t 


where 


7c 



/ + Ar 
t 


(49) 5 


(50) 10 


is defined as the impulsive force at impact, and AY- 
=Y(t + At)— Y(t) is the change in end-effector velocity 15 
before and after impact. Note that the impulsive force 
7 cis the time-integral of an ordinary finite impact force 
7 c which is very large but acts only for a very short 
time At. Equation (49) implies that the impact force is 
equal to the change in momentum before and after im- 
pact, which is the generalization of a well-known prin- 
ciple of mechanics for a point mass [19]. Equation (49) 
can be written as 

. —*> 25 

A Y=3/ J r 1 (0)7 c (51) 


Suppose that the end-effector impacts a fixed stationary 
workpiece with zero before and after velocities. Then, 
from the theory of collisions [19], we have 

[y+Af] 7 n=-ey r n (52) 


where n is the unit vector normal to the plane of impact, 
and e is the constant coefficient of restitution denoting 35 
the type of collision taking place and lies in the range 
0=e= 1, with e=0 for purely plastic and e— for 
purely elastic collisions. Since the impact fierce 7 <• is 
directed along n, it can be expressed as 7 c =7 c n, 
where the scalar 7 c denotes the magnitude of 7 c . From 40 
(48) and (49), we obtain 


-(] ± e) Y T n (53) 

n r My\6)n 


Alternatively, the upper-bound on 7 C , namely 
— (l+e)Y 7 n*\/n"’ , (0) can be reduced by defining the 
objective function as Lc(0)=X m (0) and finding the joint 
configuration 0 that maximizes the smallest eigenvalue 
of namely X m (0). Note that the reduction of 

impulsive force at impact can lead to undesirable manip- 
ulator configurations, and this goal may need to be 
considered in conjunction with other criteria. A numer- 
ical example is given in Section 3 for illustration. 

3. Case Studies 

In this section, we illustrate some of the concepts 
developed in the preceding section through simple ex- 
amples. 

Consider a planar three-link manipulator with no 
payload operating in a vertical plane as shown in FIG. 
2. The forward kinematic equations relating the absolute 
joint angles 0=[0i, 02, 03] r (w.r.t. x-axis) to the tip 
(end-effector) position coordinates Y^foy^in the base 
frame are given by 


x = cos0j + cos02 + COS03 (57) 

y — sinfli + sin02 4- sin03 


where the link lengths are taken to be unity. The differ- 
ential kinematic model is obtained as 


/ 



(0\ \ 

(k \ [ -s™ 0 ! 

—sin 02 

— sin03 I 

02 

\y ) 1 cos0i 

cos02 

cos03 J 


(58) 


The 1x3 null-space spanning vector N e of the Jacobian 
J* is found by solving the equation NeJe r =0 to obtain 

AV=[sin (#3 — 0 2)* sin (0j — #3), sin (02 — 0l)] (59) 

The dynamic model relating the joint torques *T = [t\, 
7"2» 7*3] r to the joint angles 0 is found to be 

7' =3/(0)0+A'(0, 0) + G(0)+ V6 (60a) 


Equation (53) gives an expression for the magnitude of 
the impact force 7 c in terms of the manipulator config- 
uration 0 at impact and end-effector velocity Y before 
impact. This equation is also obtained in [7] using the 50 
joint-space dynamic model (3). Since My - 1 (0) is a sym- 
metric matrix and ]] n || =1, from matrix theory [17] we 
have 

(54) 55 

where \ m and X\ are the smallest and largest eigenvalues 
of My -1 . Hence, the impact force magnitude 7 c is 
bounded by 

-d 4-e)Y r n*Aj ~ l (8)Zk 7^ -0 +e)Y r n ,X m - »(< 9 ) (55) 

In order to utilize the redundancy to “soften” the 
impact for a given Y and n, we can define the objective 
function L c (0)=n :r M ; ,~ 1 (0)n and find the manipulator 's 
configuration 0 that maximizes L c(0) subject to the 
end-effector motion. This can be achieved by formulat- 
ing the additional task as 


where the above terms are given by 

M\\ =404-30 cos (#2— #i)4-10 cos (03-02)4-10 cos 
(03-01) 

3/12=3/21 = 16.67 + 15 cos (82— 0i) + 5 cos 
(03—01)4-10 cos (03—02) 

3/13=3/31-3.33 + 5 cos (0 3 -0 2 )+5 cos (0 3 -0i) 

3/22 = 16.67+10 cos ( 8 — 0 2) 

3/23=3/32=3.33 + 5 cos (03—02) 

3/33 = 3.33 (60b) 

G 1 =25 g cos 0i + 15 g cos 02 + 5 g cos 03 
G2=15 g cos 02 + 5 g cos 03 (60c) 

6?3 = 5 g cos 03 

while g=9.81 m/sec 2 is the gravitational constant, and 
the elements of N are complicated functions of 0 and 0 
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given in Appendix 5.3. In the derivation of the dynamic 
model (60), it is assumed that the robot links can be 
modeled by thin uniform rods with masses of 10 Kg 
each, and the joint viscous friction coefficients are 
V=diag>(v/), vi=v 2=V3=30 Nt.m./rad.sec.- 1 . Since 
the end-effector workspace is of dimension two (m=2), 
the degree-of-redundancy of the manipulator is 
r=n— m= 1. This single degree-of-redundancy will 
now be used to achieve different additional tasks. Six 
cases are considered: 

3.1 Mechanical- Ad vantage 

In this case, the tip is assumed to be in contact with a 
frictionless horizontal reaction surface at y=l with 
stiffness coefficient K e = 100, as shown in FIG. 2, and 
the desired contact force is represented by 


’-(?) 


20 


We wish to move the tip on the reaction surface with 
Fj,= l, while utilizing the redundancy to minimize the 
joint torques needed to produce F,, thereby maximizing 
the mechanical-advantage of the manipulator. 

The additional joint torque required for tip contact 25 
force is given by 


BLf 

~W 


^ — w\ sin 26\ ^ 
— wi sin 202 
— W} sin 203 


The condition for optimality of L/is now given by 


10 


m = N e 


bLf 

d0 


= 0, 


where 


sin (03—02) sin 20 i+h> 2 sin (0 1 — O3) sin 
202 +W3 sin (02— 0i) sin 203 

To simplify the analysis, suppose that wi = l, 
W 2 =W 3=0 so that only the torque on joint 1, namely 
7 / 1 —cos 0i, is optimized. Then, the optimality condition 
simplifies to 


<K0)=sin (03—02) sin 20i=O 


(63) 


To apply the constant tip force of F^= 1 in the y-direc- 
tion, the tip vertical coordinate must satisfy the Hooke’s 
law 


q- F =j/(6)F = 


// COS0 1 ^ 

cos02 

cos03 
\ / 


(61) Fy—KfAy 

30 or 


Ay=F y /K e 


(64) 


It is seen that for a given tip contact force F, the re- 
quired joint torque *T iris independent on the manipula- 35 
tor configuration 0. From Section 2.3, the mechanical- 
advantage of the manipulator M a = l|F||/||‘7>|| is 
bounded by 

i! 40 

Using the end-effector Jacobian matrix given in (58), 
the above bounds are found to be 


r V /2 r V /2 


where 


a=[3 + 2 cos 2(0i — 02)+2 cos 2(0i— 03)+2 cos 
2(02-03)]* 


Lf =r T II F|| w = H’l’jl + + W3^j 

= H'icos 2 0] + H2cos 2 02 + H 3 cos 2 03 


(62) 


where {wj, W2, W3} are the joint weighting factors. The 
gradient of L/is obtained as 


Suppose that the initial joint angles are 00= [90% —45% 
45°] 7 ’so that initially the tip is at xo= V57 yo^ 1 and the 
optimality condition (63) is met with tj\— 0. Then the 
desired trajectory for the tip y-coordinate is 


y<K*)=yo+ Fy/K e = 1 + 1/100 


(65) 


Let the desired trajectory for the tip x-coordinate be 
given by 


45 


xj(t) 


= V7 + -*-u - 


+ *y (1 — cosO.5?) 


(66) 


In order to control the tip as well as minimize the joint 
torque 7/1, we require the following conditions 


50 


It is seen that the bounds on M fl are dependent on the 
manipulator configuration 0, and furthermore 55 
|t<T f\\ <V3|| F || regardless of F. In this case, since 
the direction of the applied force F is known, we can 
maximize M fl by directly minimizing the joint torque 
norm || q' f || .To this end, we utilize the redundancy to 
minimize the weighted sum-of-squares of joint torques 60 
L/ defined as 


65 


— 1 (^ 7 ) 

JC(0) = cos0i -f cos02 + cos03 = N 2 -j- — (l — cos0.5r) 

y( 6 ) — sin0i + sin02 -f sin 03 = 1.01 

4K6) = sin(03 - 02>sin20i = 0 

The robot dynamic model (60) and the configuration 
controller given in Appendix 5.4 are simulated on a 
DECstation 3100 computer with a sampling period of 
one millisecond. The simulation results are shown in 
FIGS. Za-Zd. FIG. Za shows the evolution of the robot 
configuration throughout the task. It is seen that link 1 
is kept as closely as possible to the initial optimal config- 
uration 0i =90° (i.e., vertical) so that tj\ is small, subject 
to performing the specified tip motion. FIGS. Zb and Zc 
illustrate that the tip x-position and y-contact force 
track their desired trajectories very closely. The varia- 
tion of the kinematic function <J> representing the opti- 
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mality condition is shown in FIG. 3 d. It is seen that <f> 
stays close to its initial value of zero throughout the 
task. 

Finally, from (61), it is observed that the joint torque 
H'f corresponding to the tip force F attains its minimum 
value of zero when 01=02=03=90% disregarding the 
tip position constraint. This corresponds to the robot 
fully stretched out vertically, which puts the robot in a 
singular configuration with the tip on the workspace 
boundary. In other words, the maximally singular con- 
figuration of the robot results in the absolute minimum 
joint torque for a given tip force, and hence maximum 
mechanical- advantage. Therefore, in order to preclude 
singular configurations, the maximization of mechani- 
cal-advantage must be considered in conjunction with 
other criteria such as manipulability [6], 

3.2 Gravitational Torque 

In this case, we wish to move the tip on a circular 
path, while utilizing the redundancy to minimize the 
gravity loadings on the joints. 

From (60c), the component of joint torques due to 
gravity loading is given by 


/ 


rr g = <m « 5 


% 


5 cos0i + 3 cos02 4- cos0 3 
3 cos02 4- cos#3 
cos0 3 


( 68 ) 


It is seen that for a given tip position, the joint torque 
*7^ due to gravity loading is configuration-dependent. 
The goal for redundancy resolution in this case is to 
configure the internal links of the robot such that a 
weighted sum-of-squares of gravity torques L g is mini- 
mized, that is 


L 8 


Il'Tgll W* = »\r\\ + W2 T 2 g2 + *3^3 

25g^n>i[5 cos0i 4- 3 cos02 + cos0 3 ] 2 4- 
25g 2 H>2[3 cos#2 4- cos0 3 ] 2 -j- 25g 2 w’ 3 [cos0 3 ] 2 


\j — TO 

xj( t) — N 2 4 - sin 0.5/ 

5 y<K 0 = cos 0.5/ 

so that the tip traces a circle with center (x=V2^y=0) 
and radius 1; since we have (xj— V2) 2 +y^2= 1. There- 
fore, for tip motion and gravity optimization, we re- 

10 q^ ir e 

M — (72) 

x(6) = cos#; + cos02 + cos $3 = N 2 + sin 0.5/ 
y(0) — sin0i -j- sin02 + sin0 3 = cos 0.5/ 

4>(0) — sin(02 ~ 0i)sm 26 1 = 0 

The robot dynamics (60) and the configuration con- 
troller in Appendix 5.4 are simulated, and the simulation 
20 results are presented in FIGS. 4a-4d. The evolution of 
the robot configuration throughout the motion is shown 
in FIG. 4a. It is seen that link 3 stays as closely as possi- 
ble to the initial optimal configuration 03=90° (i.e., 
vertical) so that 7 g3 is small, compatible with the execu- 
25 tion of the specified tip motion. FIGS. 4b and 4c show 
the responses of the tip x and y coordinates, and illus- 
trate that the desired trajectories Xd and yd are tracked 
very closely. The variation of the kinematic function tj> 
is depicted in FIG. 4d , which shows that 4> stays close 
30 to its desired value <f>j=0 throughout the task. 

3.3 Inertia Control 

In this case, we wish to move the tip on the vertical 
straight line at x= 1.5, while utilizing the redundancy to 
make the inertia seen at joint 1 configuration-invariant 
35 throughout the tip motion. 

From (60b), it is seen that the joint inertia matrix 
M(0) is dependent only on the manipulator configura- 
tion 0. Thus, the redundancy can be resolved based on 
the inertia matrix. For instance, let the initial joint an- 
40 gles be 0°=[6O% —60°, bO^so that the tip is initially at 
x 0 = 1.5, 


where {wi, W2, W3} are the joint weighting factors. For 
instance, let us choose wi=W2=0, W3=l so that only 
the gravity torque on joint 3, namely r g3 = 5 g cos 03, is 
optimized. Thus, we obtain 

Lg = 25$ 2 cos 2 0 3 (70a) 



and from (60b) the initial value of joint 1 inertia is 

■Mll(0°)=4O-|-3O cos (020— 0io)4- cos 
(030— #20)+ 10 cos (030— 0K>)= 30 (74) 


45 


50 


00 


( 


0 

0 

— 25^ sin 203 


) 


(70b) Let the desired trajectories for the tip coordinates be 


55 


M0 = 1.5 


(75) 


Therefore, in order to optimize L g subject to the tip 
constraint, we require 


MO - 


M7 


cosO.5/ 



— 25s 2 sin(02 — 0i)sin 203 — 0 


Therefore, in order to keep Mn(0) constant and control 
' ) 60 the tip coordinates, we need 


Suppose that the reaction surface used in Case One is 
removed (i.e., F=0), and the tip is free to move in both 
x and y directions. Initially, the joint angles are 65 
00= [45% —45°, 90°] r and hence the tip is at xo= VX 
yo= 1 and the optimality condition (56) is met with 
7 g 3=0. Let the desired tip trajectories be given by 


x(0) = cos0i 4- cos02 4* cos03 — 1.5 


y{6) — sin0i 4- sin02 -f sin03 = 


V7 


cosO.5/ 


M\\{6) = 40 4 - 3Ocos( 0 2 - 0i) 4- lOcos(0 3 - 0 2 ) 4- 


( 76 ) 
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-continued 

lOcos(0 3 - 6 \) = 30 

The robot dynamics (60) and the configuration con- 
troller in Appendix 5.4 are simulated, and the simulation 
results are given in FIGS. 5a-5rf. FIG. 5 a depicts the 
evolution of the robot configuration during the task. It 
is observed that as the tip moves closer to the base in 
mid-motion and joint 1 inertia is decreased, the inner 
links move outward to increase the inertia, so as to 
maintain the total inertia Mu constant. For some tip 
trajectories, it may not be possible to keep Mu constant 
throughout the motion; e.g., when the tip is required to 
move out toward the workspace boundary, all links 
have to move out accordingly and Mu is increased 
inevitably. However, in this case, the variations of Mu 
from its initial value Mn(#°) can be minimized. FIGS. 
Sb and 5c show that the tip x and y coordinates track 
their reference trajectories very closely. The variation 
of the joint 1 inertia is depicted in FIG. 5 d and indicates 
the invariance of Mh(0) throughout the motion. 

3.4 Compliance Control 

The goal for redundancy resolution in this case is to 
maintain a constant tip compliance while the tip is tra- 
versing a prescribed path. 

The compliance matrix C(0) relating the tip forces to 
the tip deflections is given by (43) as 


22 

configuration in FIG. 6a shows the internal movement 
of the robot links to maintain the compliance C22W 
constant. FIGS. 6b-6d show the variations of the tip x 
and y coordinates and compliance C22(0), an d illustrate 
5 that close trajectory tracking is achieved throughout 
the motion. 

3.5 Tip Sensitivity 

In this case, the tip is assumed to be at the point 
P[x=0, y~(l4-\^/v2], and make contact with a stiff 
10 horizontal reaction surface at y=(l+V7)/V2T We 
wish to find the optimal configuration of the manipula- 
tor so that the joint displcements A0=(A0i, A62, AOz) 7 
due to servo errors have the least effect on the y-coor- 
dinate of the tip, i.e., the sensitivity of y to AO is mini- 
15 mized. This is because any perturbation Ay in y will be 
magnified by the stiffness K of the reaction surface and 
will produce and undesirable additional contact force 
KAy. 

To find the optimal configuration, we first parameter- 
20 ize the self-motion of the manipulator in terms of the 
first joint angle 0\ for the given tip location P=[0, 
(1 + v7/V2j. A simple geometrical anaylsis shows that 
the range of variation of 0\ which keeps the tip fixed at 
P is given by 45° = 135°. Let the points A and B 
25 represent the ends of the first and second links of the 
arm. For each value of 0\> the point A is fixed and we 
have a two-link arm (AB, BP) formed from the second 


C(B) = U6)K-lj e T(6) = 


^ sin 2 0i sin 2 <?2 sin 2 0 3 
*1 + *2 + *3 

sin20] sin202 sin20 3 

l ” ~ 2ki ~ 


— sin20i 
2*1 


sin2#2 

~2*r 


sin20 3 ^ 

~ ~ 


(77) 


COS 2 01 COS 2 02 COS 2 0 3 j 

~ + * 3 J 


where {ki, k2, k 3 ) are the joint stiffness coefficients. Let 
us suppose that ki = k2 = k3=0.1 and the tip is carrying 
a payload of mass m so that the Cartesian force 

is acting on the tip. The tip deflection caused by the 
payload is 


(78) 

f — sin20j — sin202 — sin20 3 | 

AV = C(6)F = -5 mg + + 

We now wish to utilize the redundancy to ensure that 
the tip vertical deflection under the payload is indepen- 
dent of the robot configuration. The robot is assumed to 
be initially at 0°=[9O O ,O°,— 90 0 ] 7 ’, so that the tip is at 
xo= 1, yo=0, and the corresponding tip y-compliance is 
C22(0°)= 10. We wish to keep C22W constant while 
moving the tip on the vertical straight line at x = 1. This 
requires 


x(0)-cos 01 + COS 02+ cos 03=1 


and third links. Given A and P, there are two inverse 
kinematic solutions ABjP and AB2P for ( [62 , #3) corre- 
sponding to the “elbow-up” and “elbow-down” config- 
urations. Because of symmetry of the solutions, here we 
40 only consider the “elbow-up” solution ABjP for which 
Bi is to the right-hand side of B2. We now wish to find 
the value of 0\, the redundancy parameter, for which 
the tip sensitivity in the y-direction is minimized given 
the joint displacements A 6. From Section 2.5, the tip 
45 and joint displacements are related through the Jaco- 
bian matrix J e as 


50 



—sin 02 


cos 02 


— sin0 3 


COS0 3 


'A01 > 
A0 2 
,A0 3> 


(80) 


Hence the objective function to be minimized is given 
55 by 

(A0i cos 0|+A0 2 cos 02+A0 3 cos 0 3 )^ (81) 

The necessary condition for optimality subject to the tip 
5Q constraint is 


_y(0)=sin 0i+sin 02+sin 02=0.5(1— cos 0.50 (79) 

C22(0)=lO(cos 2 0i + cos 2 +cos 2 0 3 )=1O 

The robot dynamics (60) and the configuration con- 
troller in Appendix 5.4 are simulated, and the results are 
presented in FIGS. 6 a-6d. The evoluation of the robot 


w = 0 


65 where N e is given by (59), that is 

2[A0 1 cos 0 j + A02 cos 02 + A0 3 cos 0 3 ][A0 j sin 0 j sin 
(02 — 0 3 )+A02 sin 02 sin (0 3 — 0i)+A0 3 sin 0 3 sin 
(0! -02)]=O 


( 82 ) 
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Given the numerical values of the joint displacements 
as A0=]5% 1°, 1°] the value of the objective function L 
and its projected gradient <}>(0) are plotted in FIGS. 
la-lb for variations in the redundancy parameter 0j. 
From FIG. la, for the “elbow-up” solution, the opti- 
mum configuration of the manipulator for which the tip 
y-sensitivity is minimized is found to be 

e 1 = 90’, #2 « 52.O9\0 3 *= 1 27.9 1° (83) 

Note that since A02= A03 in this case, the contributions 
from joints 2 and 3 to the tip displacement Ay cancel 
out, and the value of 0i = 90° makes the contribution of 
A0i to Ay zero. Furthermore, note that from FIG. lb, 
the necessary condition for optimality is satisfied at 
three different sets of joint angles. However, from FIG. 
la, the other two sets do not correspond to truly opti- 
mal solutions. 

3.6 Impact Force 

In this case, the redundancy is utilized to reduce the 
impulsive force when the tip impacts a reaction surface 
and the collision has the coefficient of restitution e = 1. 

As in Section 3.5, suppose that the reaction surface is 
located at y = (l + VTj/V^ and the tip is moving 25 
toward the contact point P[x=0, y=(l+V7)/V2] on 
the surface with the approaching Cartesian velocity 
Y = [0 \] T just before impact. From Section 2.7, the 
magnitude of the impact force is given by 

30 

* _ -0 ± e)Y r w = 2 < 84 ) 

CTC n T M~\B)n [M~\e ) ] 2 , 2 

where n = [0 l] r , M > ;- 1 =J e M- 1 J e ;r , and the subscript 35 
2,2 refers to the (2,2) element of the matrix. It is seen 
that the size of the impact force 7 c is dependent on the 
manipulator configuration 0, and can therefore be af- 
fected through redundancy resolution. As in Section 
3.5, the redundancy is parameterized in terms of the first 40 
joint angle 0 1, while the remaining joint angles 02 and 
03 are solved for given 0j and the tip position (x,y). In 
order to find the optimal value of 6\ that minimizes 7 c , 
we define L(0) = [M y “ 1 (0)]2,2 as the objective function 
and express the necessary condition for optimality as 45 
<J>(0)=O, where 


prior to contact produces the minimal impulsive force 
at impact with the reaction surface. Note that in this 
case the links one and two are nearly colinear (to within 
2.7°) which is not a desirable configuration from the 
manipulability point of view. 

4. Conclusions 

New goals for redundancy resolution based on ma- 
nipulator dynamics and end-effector characteristics are 
introduced in this specification. These goals include 
reduction of joint torques due to gravity or inertial 
effects and improvement of mechanical advantage, ve- 
locity ratio, end-effector compliance, sensitivity or im- 
pact force. Thus in the manipulator dynamic model, the 
static torques due to payload, contact force and gravity 
loading can be controlled directly, while the inertial 
torque can be influenced through the end-effector mass 
matrix. The configuration control approach used previ- 
ously to obtain desirable kinematic characteristics is 
now employed to improve end-effector or dynamics- 
based measures of performance. Although some of the 
goals for redundancy resolution described here can be 
computationally intensive for on-line control implemen- 
tation, they provide a viable approach for off-line mo- 
tion planning. The control schemes presented in this 
specification utilize the redundancy of a robot based on 
the task to be performed. These task-based redundancy 
resolution schemes exploit the redundant joints to a 
much greater extent. 

There is a subtle difference in optimization using the 
conventional Jacobian pseudoinverse control and the 
configuration control approach. In the pseudoinverse 
control, the objective function L is locally improved 
(increased or decreased) at each incremental step, and is 
not necessarily optimized (maximized or minimized) 
during the end-effector motion. In other words, the 
pseudoinverse control provides a feasible direction 
without solving the complete optimization problem [5]. 
In the configuration control approach, however, the 
optimality condition (i.e., 

N ‘-it = °> 

is forced explicitly as the additional task constraint 
during the end-effector motion, and thus locally optimal 
configurations are closely maintained throughout the 


<f>W = 

is the projected gradient of L. FIG. 8a shows the varia- 
tion of the kinematic function <j>(0) representing the 
optimality condition as a function of the redundancy 
parameter 0\ for the “elbow-up” solution. It is seen that 
<J>(0)=O when 0j = 67.95° or 01 = 132.80°, indicating 
that the impact force magnitude 7 c will have ex- 
trimums (maximum or minimum) at these two values of 
01. FIG. 8 b shows the variation of 7 c as a function of 
01. It is seen that the impact force magnitude 7 c varies 
in the range (3.4, 20.5) when 0i changes in the allowable 
range (45°, 135°), with the maximum occuring at 

01 = 132.80°. The minimum value of Hr c at 3.4 is found to 
occur for 0i =67.95° and the corresponding values of 

02 and 03 for the “elbow-up” solution are found to be 
02 = 70.65° and 0 3 = 134.96°. Hence the optimal arm 
configuration 

(85) 


trajectory. Note that for a general objective function 
L(0), the gradient dL/d0 is not readily available analyti- 
cally and must often be computed numerically using 
differencing. 

The individual additional tasks described in this spec- 
ification for redundancy resolution can be combined 
together with user-assigned priorities. In fact, it is often 
advisable to consider the main goal for redundancy 
resolution in conjunction with other criteria to ensure 
that the manipulator configuration is desirable from an 
overall standpoint. The “optimal” joint trajectory that 
will best satisfy the individual additional tasks, as well 
as the basic task of end-effector motion, can then be 
found using the method described in [14]. This frame- 
work can also be used to avoid potential conflicts be- 
tween the end-effector motion and the redundancy 
resolution constraints, so that the end-effector tracking 
accuracy is not sacrificed unduely for satisfaction of the 
constraints [14], 

Further research on expanding the redundancy reso- 
lution goals and improving the computational aspects of 


6 = [67.95% 70.65% 134.96°[ r 
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the end-effector and dynamics-based configuration con- 
trol schemes is currently underway. 
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5. Appendices 

5.1 Condition for Constrained Optimization 

In this appendix, we derive the condition for optimi- 
zation of an objective function under the end-effector 
motion constraint. This result is obtained in [14] and is 
repeated here for completeness. 

Let L(0) denote the scalar kinematic objective func- 
tion to be optimized by the utilization of redundancy. 
The redundant manipulator control problem is to find 
the joint trajectory 6 that optimizes L(0) subject to the 
end-effector constraint Y=f(0). The solution to this 
constrained optimization problem can be obtained using 
Lagrange multipliers. Let the augmented scalar objec- 
tive function L*(0,p) be defined as 

L\e,p)=m+p T [Y-m] ( 86 ) 

where p is the mXl vector of Lagrange multipliers. 
The necessary conditions for optimality can be written 
as 



Now, let N e be a full-rank rXn matrix whose rows span 
the r-dimensional null-space of the end-effector Jaco- 
bian matrix J e , that is, NeL r =0. Then, premultiplying 
(87) by N<? yields the optimality condition as 

N e -%- = 0 (89) 

Equation (89) implies that the projection of the gradient 
of the objective function L(0) onto the null-space of the 
end-effector Jacobian J e must be zero for optimality. 
55 Note that the initial configuration of the robot must be 
optimal, i.e., L(0O) should be a local maximum or mini- 
mum. The matrix N e can be constructed in several ways. 
It can easily be verified that one formulation for N c is 

60 N e =[I,c-Je\ T (J'2 T r l ] (90) 

where 3 e \ and J e 2 are mxr and mXm partitions of 3 e 
defined by J3 = [J<?i:J*2]» and I r is the rXr identity ma- 
trix. Since J e has rank m, the m linearly independent 


Robotics and Automation, pp. 1195-1200, Sacramento, 65 columns of J e can always be grouped together to form 
April 1991. the m X m nonsingular matrix J e 2 and the same reorder- 

17. J. N. Franklin: Matrix Theory , Prentice-Hall Inc., ing must be done on dL/60. Note that N*is independent 

Englewood Cliffs (N.J.), 1968. of the objective function L to be optimized. Strictly 
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speaking, equation (89) is only a necessary condition for 
optimality. However, by choosing L(0) to be a convex 
function, as is usually possible in robotics applications, 
condition (89) becomes both necessary and sufficient. 
Equation (89) was first derived by Baillieul [20] using a 
different approach and used for redundancy resolution 
in the extended Jacobian method. By treating 

*<«> = 

as the kinematic function and setting <J>^(t)=0, the opti- 
mization problem is formulated as an additional task 
within the configuration control framework. Therefore, 
the extended Jacobian method of Baillieul is obtained as 
a special case of the configuration control scheme. 

5.2 Relationship between eigenvalues of and H v 
In this appendix, we find the relationship between the 
eigenvalues of the mXm matrix H m (0)=Je(0)Je r (0) and 
the nxn matrix Hy(0)=Je r (0)Je(0). 

Let us express the m X n end-effector Jacobian matrix 
J<? in the singular-value decomposition (SVD) form 

J e =UlV T (91) 

where U and V are mXm and nXn orthogonal matri- 
ces, i.e., U-^U^and V- 1 =V 7 ', while 2 is an mXn 
matrix, m<n, with the special diagonal form 


o ■ 

<T2 O 

o **• ■ 


in which o*i, . . . , cr m are the m singular values of J e . 
Then, we obtain 


H m = JeJ e T = (uiv T )(Vi T u T ) = uaz T )U T 


= v 


Lo 


o 




Hy = J/J e = (VI. T U T ){m.V T ) = V('1 T 1)V T 


= V 


°"m 


2 


o 
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the m eigenvalues of H m and (n — m) zeros; that is, [cn 2 , 
. . . , cr m 2 , 0, . . 

5.3 Coriolis/centrifugal torque 
In this appendix, expressions are given for the Cori- 
5 olis/centrifugal torque in the Example of Section 3. 

In the dynamic model (60) of the three-link robot, the 
elements of the Coriolis and centrifugal torque vector N 
(0, 0) are as follows: 


10 jVi = -3001(02 - 0i)sm(02 - 0l) - 1001(03 - 02>sm(03 - 02) ~ 
1001(03 - 0i)sm(03 - 0i) - 15 (0 2 - - 0i) - 

10(02 - 0lX?3 - 02 >sin (03 - 0 2 ) - 
. 5(02 - 0iX*3 - - 0i) - . 

5(03 - 0 2 )sin(03 - 02) - 5(03 - 0 2 X$ 3 - 0lXin(0 3 - 0i) 

15 N 2 = -1001(03 - 02)sm(03 - 0 2 ) - 

. . 10(02 - ^iX03 - 02)sin(0 3 ~ 0 2 )~ 

5(03 - 0 2 ) 2 sin(03 - 0 2 ) + 150 I 2 sm(0 2 - 0j) + 50i 2 sin(0 3 - 0i) 

- 02) -f. 50i 2 sin(03 — 0j) + 

1O0i( 02 - 0j)sm(03 — 02) + 

20 5(02 - 0i)sin(03 - 0 2 ) 


5.4 Configuration Controller 

In this appendix, we describe the configuration con- 
troller used in the Example of Section 3. 

25 Following [9], the configuration controller for the 
robot in Section 3 is given by 

‘T=^(0+Ap(/)E+^0£4-a^+5(/)i- 
d+A(t)X d ] (94) 

30 where J is the 3x3 augmented Jacobian matrix, 
E=X<*— X is the 3x1 configuration tracking-error 
vector, and the controller terms {d, K^, K v , C, B, A are 
generated on-line according to the following adaptation 


r t (95) 

q = 5000E + 500£; d{t) = 0.5 g(t)di 
J 0 


Kfi) = 2 T g{t)Ejit)dt; v(/) = 2 f ' q{t)E T {t)dt 
J 0 J 0 
(92) 


UT 


(93) 


O 


0 


V T 


0 


We conclude that the m eigenvalues of H m , namely 
[cr] 2 , . . . , cr m 2 ] , are the squares of the singular values 
of 3 e . Furthermore, the n eigenvalues of H v consist of 



29 

-continued 


0.1) = 0.5 J 

<Kt)x d T w 

0 

B(t) = 0.5 J 

t 

qO)X d T m 

0 

o 

il 

' qO)Xd T W 
0 


where the initial values of all the controller terms are 
chosen as zero. Note that the same control law (94) and 
adaptation laws (95) are used in all four Cases 3. 1-3.4. 
For each case, the corresponding augmented Jacobian 



is used in the control law (94), where J e is given in (58) 
and J c in each case is as follows: 

Case 3.1 

y c =[2 sin ( 63 - 82 ) cos 26 1 , -cos (03-02) sin 20 1, 
cos (03-02) sin 2 

Case 3.2 

J c =[~cos (02— 0l) sin 2 03, cos (02— 0l) sin 203, 2 
sin (02— 0i) cos 2 

Case 3.3 

J c — [30 sin (02 — 0i)-f 10 sin (03 — 0i), —30 sin 
(02—00+10 sin (03—10 sin (03-02)- 10 sin 
(03-0 

Case 3.4 

J c =[- 10 sin 20i, - 10 sin 20 2 , - 10 sin 20 3 ] 

What is claimed is: 

1. A method of controlling a redundant robot having 
n joints operating in m-dimensional task space with 
redundancy r=n-m, and having an end effector, said 
method comprising: 

first defining a basic task motion of said robot within 
a set of end-effector coordinates, corresponding to 
m constraints on movement of said n joints; 
second defining not more than r constraints on said 
basic task motion corresponding to a minimization 
of gravity loading on said joints, wherein said sec- 
ond defining comprises, 

defining an n-by-r matrix operator, N e , spanning a 
null space of a Jacobian operator of said end- 
effector, 

defining an n-by-1 vector which is a partial deriva- 
tive of a gravity loading function with respect to 
angles of said joints, and 

setting the product of said matrix operator and said 
vector to zero as a minimization condition; and, 
controlling said joints so as to simultaneously fulfill 
the m constraints of said basic task motion and the 
r constraints of said minimization of gravity load- 
ing. 

2. The method of claim 1 wherein said gravity load- 
ing function is a function of the angles of all of said n 
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joints and comprises a sum over all of said n joints of 
squares of elements of a vector of gravity loading on 
respective joints. 

3. The method of claim 2 wherein said gravity load- 
ing function is defined in terms of n individual 
weighting factors associated with respective ones of 
said n joints, said weighting factors determining the 
joints for which gravity loading is minimized. 

4 . A method of controlling a redundant robot having 
n joints operating in m-dimensional task space with 
redundancy r=n-m, and having an end effector, said 
method comprising: 

first defining a basic task motion of said robot within 
a set of end-effector coordinates, corresponding to 
m constraints on movement of said n joints; 

second defining not more than r constraints on said 
basic task motion corresponding to a minimization 
of joint inertia on said joints, wherein said second 
defining comprises, 

defining an n-by-r matrix operator, N c , spanning a 
null space of a Jacobian operator of said end- 
effector, 

defining an n-by-1 vector which is a partial deriva- 
tive of a joint inertia function with respect to 
angles of said joints, and 

setting the product of said matrix operator and said 
vector to zero as a minimization condition; and 

controlling said joints so as to simultaneously fulfill 
the m constraints of said basic task motion and the 
r constraints of said minimization of joint inertia. 

5 . The method of claim 4 wherein said joint inertia 
function is a function of the angles of all of said n joints 
and comprises a sum over all of said n joints of off-dia- 
gonal joint-coupling elements of a joint inertia matrix 
for each one of said joints. 

6. A method of controlling a redundant robot having 
n joints operating in m-dimensional task space with 
redundancy r=n-m, and having an end effector, said 
method comprising: 

first defining a basic task motion of said robot within 
a set of end-effector coordinates, corresponding to 
m constraints on movement of said n joints; 

second defining not more than r constraints on said 
basic task motion corresponding to an optimization 
of joint mechanical advantage of said joints, 
wherein said second defining comprises, 
defining an n-by-r matrix opertor, N e , spanning a 
null space of a Jacobian operator of said end- 
effector, 

defining an n-by-1 vector which is a partial deriva- 
tive of a joint mechanical advantage function 
with respect to angles of said joints, and 
setting the product of said matrix operator and said 
vector to zero as a minimization condition 
whereby to minimize joint mechanical advan- 
tage; and 

controlling said joints so as to simultaneously fulfill 
the m constraints of said basic task motion and the 
r constraints of said optimization of joint mechani- 
cal advantage. 

7. The method of claim 6 wherein said joint mechani- 
cal advantage function is a function of the angles of said 
joints and comprises a projection of an end effector 
Jacobian matrix of a respective joint and a unit vector of 
a direction of applied force of an end effector for each 
joint. 


5 


10 


15 


20 


25 


30 


35 


40 


45 


50 


55 


60 


65 



5,294,873 


31 

8. A method of controlling a redundant robot having 
n joints operating in m-dimensional task space with 
redundancy r=n-m, and having an end effector, said 
method comprising: 

first defining a basic task motion of said robot within 5 
a set of end-effector coordinates, corresponding to 
m constraints on movement of said n joints; 
second defining not more than r constraints on said 
basic task motion corresponding to an optimization 1Q 
of an end effector-to-joint angle velocity ratio, 
wherein said second defining comprises, 
defining an n-by-r matrix operator, N* spanning a 
null space of a Jacobian operator of said end- 
effector, 15 

defining an n-by-1 vector which is a partial deriva- 
tive of an end effector-to-joint angle velocity 
ratio function with respect to angles of said 
joints, and 

setting the product of said matrix operator and said 20 
vector to zero as a minimization condition; and, 
controlling said joints so as to simultaneously fulfill 
the m constraints of said basic task motion and the 
r constraints of said optimization of an end effector- 
to-joint angle velocity ratio. 

9. The method of claim 8 wherein said end effector- 
to-joint angle velocity ratio function comprises projec- 
tions of end effector Jacobian matrices of respective 
joints and an angular velocity vector of respective 30 
joints. 

10. A method of controlling a redundant robot hav- 

ing n joints operating in m-dimensional task space with 
redundancy r=n-m, and having an end effector, said 
method comprising: 35 

first defming a basic task motion of said robot within 
a set of end-effector coordinates, corresponding to 
m constraints on movement of said n joints; 
second defining not more than r constraints on said 
basic task motion corresponding to optimization of 40 
end effector movement sensitivity, wherein said 
second defming comprises, 

defming an n-by-r matrix operator, N c , spanning a 
null space of a Jacobian operator of said end- 
effector, 45 

defming an n-by-1 vector which is a partial deriva- 
tive of an end effector movement sensitivity 
function with respect to angles of said joints, and 
setting the product of said matrix operator and said 50 
vector to zero as a minimization condition; and, 
controlling said joints so as to simultaneously fulfill 
the m constraints of said basic task motion and the 
r constraints of said optimization of end effector 
movement sensitivity. 55 

11. The method of claim 10 wherein said end effector 
movement sensitivity function comprises a trace of a 
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product of an end effector Jacobian matrix with its 
transpose. 

12. A method of controlling a redundant robot hav- 
ing n joints operating in m-dimensional task space with 
redundancy r=n-m, and having an end effector, said 
method comprising: 

first defming a basic task motion of said robot within 
a set of end-effector coordinates, corresponding to 
m constraints on movement of said n joints; 
second defining not more than r constraints on said 
basic task motion corresponding to optimization of 
end effector compliance, wherein said second de- 
fining comprises, 

defming an n-by-r matrix operator, N e , spanning a 
null space of a Jacobian operator of said end- 
effector, 

defming an n-by-1 vector which is a partial deriva- 
tive of an end effector movement compliance 
function with respect to angles of said joints, and 
setting the product of said matrix operator and said 
vector to zero as a minimization condition; and, 
controlling said joints so as to simultaneously fulfill 
the m constraints of said basic task motion and the 
r constraints of said optimization of end effector 
compliance. 

13. The method of claim 12 wherein said end effector 
compliance function comprises a sum of squares of 
matrix elements of a projection of an end effector Jaco- 
bian matrix on a joint stiffness matrix. 

14. A method of controlling a redundant robot hav- 
ing n joints operating in m-dimensional task space with 
redundancy r=n-m, and having an end effector, said 
method comprising: 

first defming a basic task motion of said robot within 
a set of end-effector coordinates, corresponding to 
m constraints on movement of said n joints; 
second defming not more than r constraints on said 
basic task motion corresponding to optimization of 
end effector impact force, wherein said second 
defming comprises, 

defining an n-by-r matrix operator, N e , spanning a 
null space of a Jacobian operator of said end- 
effector, 

defining an n-by-1 vector which is a partial deriva- 
tive of an end effector impact force function 
with respect to angles of said joints, and 
setting the product of said matrix operator and said 
vector to zero as a minimization condition; and, 
controlling said joints so as to simultaneously fulfill 
the m constraints of said basic task motion and the 
r constraints of said optimization of end effector 
impact force. 

15. The method of claim 14 wherein said end effector 
impact force function comprises a projection of an end 
effector mass matrix on a unit vector of an impact force 
of an end effector. 
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